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Abstract of DE1 9940007 

The invention relates to a method and a device 
for supporting parking of a vehicle using a 
parking assistant. Signals concerning driving 
status supplied by sensors (2) are used to 
calculate a theoretical trajectory in a function 
block. Said trajectory consists of clothoid curves 
and/or a circular curves. Signals supplied by the 
sensors (2), in particular yaw angle signals and 
trajectory signals are used to calculate an actual 
trajectory in a function block (4). Theoretical and 
actual trajectories are then compared. The result 
of said comparison enables real-time calculation 
of the steering angle during the different phases 
_ofJhe-parkmg:maneuver-for-Vvhjch-a:parameter-is- 



determined in a function block (5). Feed-back 
signals supplied by the sensors (2) enable exact 
regulation of the steering angle adopted during 
the parking maneuver. Steering wheel 
movements caused by the driver are tolerated 
but do not have any influence on the steering 
angle. The driver only has to press the 
accelerator and brake pedal to influence the 
speed of the vehicle. 
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Prufungsantrag gem. § 44 PatG ist gestellt 

@ Verfahren und Vorrichtung zur Unterstutzung des Einparkens eines Kraftfahrzeugs 

2@: Qi_e_E r.f i rid unq befasst sich miteinem Verfahren undei- 



o 
o 

o 
*t 
o 



ner Vorrichtung zur Unterstutzung des Einparkens eines 
Kraftfahrzeugs, d. h. mit einem Einparkassistenten. Aus 
von Sensoren (2) gelieferten Fahrzustandssignalen wird 
in einem Funktionsblock (3) eine Soll-Trajektorie berech- 
net. Diese besteht aus Klothoidbogen und/oder Kreisbo- 
gen. Ferner wird auf der Basis der von den Sensoren (2) 
gelieferten Signale, insbesondere eines Gierwinkelsi- 
gnals und eines Wcgesignals, eino Ist-Trajektorio in oinom 
Funktionsblock (4) berechnet. Dann werden Soil- und Ist- 
Trajektorien verglichen, und das Vergleichsergebnis er- 
moglicht eine mit den Phasen des Einparkvorgangs 
schritthaltcndo Bcrochnung des Lcnkwinkels, fur den in 
einem Funktionsblock (5) eine StellgrofSe ermittelt wird. 
Von den Sensoren (2) gelieferte Feed-back-Signale er- 
moglichen eine genaue Regelung der wahrend des Ein- 
parkvorgangs eingeschlagenen Lenkwinkel. Lenkradein- 
gritfe des Fahrers werden tolerien, habnn aber keine Aus- 
wirkung auf den Lenkwinkel. Der Fahrer muss lediglich 
Gas- und Bremspedal betatigen, um die Fahrgeschwin- 
digkeit des Fahrzeugs zu beeinflussen. 
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Beschreibung 
Stand dcrTechnik 

Die Erfindung bemfftein Verfahren zur UnterstUtzung des Einparkens eines Kraft fan rzeugs, das mit. einem I .enkstcll- 
motor und Sensoren zum Erfassen der Fahrzeug position, des Fahrzustands und veranderlichcr Umgebungsbcdingungcn 
ausgeriistet isl, wobei auf den Bcfehl cines Fahrers hin cine gcrcgelte UnterstUtzung des Einparkvorgangs mitlels des 
Lenkstellcrs und gestUizt auf vorbestirnmte Fahrzeugdaten und auf Signale der Sensoren ausgefUhrt wird, sowic ein zur 
Durchfiihrung des Verfahrens eingeriehlete Vorrichlung. 

Bei cinem zur Zeit bci der Robert Bosch GmbH in der Entwicklung befindlichen clektronischen Lenksysteni wird 
durch einen am Lcnkgctriebc der Vorderrader angebrachten elektronisch geregelten Lenkstcller, ausgehend von eincm 
von einem Lcnkradsensor crfassten Fahrerlenkwunsch unter Bcrucksichtigung von fahrdynamischen GroBen die Qucr- 
dynaniik durch eine Modification des dem Fahrerlenkwunsch entsprcchenden Lenkwinkels vcrbessert, d. h., dass das 
Fahrzeug in fahrdynamischen Situationcn stabilisiert wird. Das System wcist einen Lenkstcilmotor auf, der dern vom 
Fahrer gestellten Lenkwinkel einen Korrekturwinkel hinzuaddiert. 

Die DE 29 0 1 504 beschreibt ein Verfahren und eine Vorrichlung zum Einparken von Kraftfahrzeugcn, wclchc nut ei- 
ner reinen Steuerung des Einparkvorgangs arbeitet. Dabei werden keinc den Vcrlauf der Einpark-Trajektorie veranderndc 
Fccd-Back-Signale berucksichtigt, sondern slatt dessen feste Trajektorien vorgegeben. 

Aus rtem Patent. FR 2 728 859 isl ein Verfahren und eine Vorrichlung zur Regelung des Einparkvorgangs bekannl . Da- 
bei ist aber der Fahrer noch zustandig. urn Lenkeingriffe durchzufuhren. Dazu werden Sensoren verwendet, die den Gier- 
winkel und den Lenkwinkel erfassen. Unbefriedigend ist dabei, dass die Leistung des damit realisiertcn Systems durch 
die relativ groBe Tbtzeit des Fahrers bei den Lenkeingrififcn beeintrachtigt ist. 

Aufgabe und Vorteilc der Erfindung 

Es ist Aufgabe der Erfindung, ein Verfahren und cine Vorrichlung zur UnterstUtzung des Einparkcns cines Krafifahr- 
zeugs so zu crmoglichen, dass das Fahrzeug automatisch in die Parklucke lenkt, der Fahrer aber selbst durch Gaspedal- 
und Bremspedaleingriffe die Geschwindigkeit regelt. 

Die obige Aufgabe wird anspruchsgemaB gelost. 

GemaB einem wesentlichen Aspekt ist das die obige Aufgabe losende Verfahren gekennzeichnct durch folgende 
Schriite: 

A Erfassung einer das unterst.ut.zte Einparken initiierenden Belehlseingabe des Fahrers und Erzeugung eines Tnilia- 
lisierungssignals; 

B Erfassung der momentanen Fahrzeugposition und des Fahrzustands aus den Fahrzeugdaten und wemgstens aus 
einem Gierwinkel signal und aus einem Wegesignai; 

C Erfassung der Umgebungsbedingungen aus von an dem Fahrzeug angebrachten Sensoren erzeugien Signalen; 
D Vorgabe einer oder mehxerer Soil-Taj ektorien, die eine von der Fahrzeugposition, dem Fahrzusland, den Umge- 
bungsbedingungen und den Fahrzeugdaten abhangige Soll-Bahnkurve des einzuparkenden Fahrzeugs angeben; ^ 
E Erfassung einer jcwciligcn Ist-Trajcktoric, abhangig von den jcwciligcn in den Schrittcn B und C crfassten Si- 
gnalen; 

F Vergleicb der in Schritt D vorgegebenen Soll-Trajektorie und der in Schritt E erfassten Ist-Trajektorie; und 

G Berechnung der jeweiligen StellgroBe fur den Lenkstellmotor aus dem in Schritt F erhaltenen Vergleichsergeb- 

i^nis. ~ : 'z ~ - - - _ - - — - — — *z : — '—j: — ; — _ — : — - 

Dabei wird das in Schritt B erfasste Wegesignai vorteilhafterweise von einem Weggeber, vorzugsweise von je cinem 
an jedem Fahrzeugrad befindlichen RadgeschwindigkeiLssensor, erf asst.. Das ebenfaUs in Schritt erfasste Gierwinkelsi- 
gnal kann entweder durch einen geeigneten Sensor gemessen werden oder aber aus geeigneten Signalen, bspw. aus der 
Drehrate eines Drehratensensors und/oder aus den Radgeschwindigkeiten, rekonstruiert werden. 

Die Umgebungsbedingungen werden in Schritt C vorzugsweise mittels eines Ultraschallsensors erfaBt. Es ist jedoch 
auch denkbar Radarsensoren oder oplische Sensoren, z. B. Kameras, einzusetzen. Die in Schrill C erfassten Umgebungs- 
bedingungen konncn die Form oder AusmaBe einer Parklucke angeben. 

Die oder jede in Schritt D vorgegebene Soll-Trajektorie wird bevorzugt aus einem oder mehrcren Klothoidbogen und/ 
oder aus cinem oder mehrcren Krcisbbgcn zusammcngesctzt. Ein Klothoid ist cine cbene Kurvc, dcrcn Kriimmungsra- 
dius gemaB der Beziehung R = a ■ a/s (R: Krummungs radius; s: Bogenlange; a: Parameter) stetig kleincr wird. 

Urn zu vermeiden, dass die Lenkbeschleunigung und der Lcnkruck zu hoch werden, wird die ini Schritt E berechncte 
StellgroBe einer Filterung unterworfen, die abrupte Ubergange an den Flanken der StellgroBe glattet. 

Eine zur Durchfiihrung des Verfahrens eingerichtete Vorrichtung weist erfindungs gemaB eine Regel-/ Steuereinheil, 
die von den Sensoren in Abhangigkeit von der Fahrzeugposition, dem Fahrzustand und den veranderlichen Umgebungs- 
i bedingungen erzeugien Signale sowie die Fahrzeugdaten empfangt, Mittel zur Berechnung einer Ist-Trajektorie aus den 
Sensorsignalcn und den Fahrzeugdaten, Millel zum Vergleich der jeweils hcrechnelen rsl-Trajektorie mil einer vorbe- 
stimmten Soll-Trajektorie und Mittel zur Berechnung einer SlellgroBe fur einen Lcnkstell motor aus dem Vcrgleichser- 
gebnis auf. 

Die das Verfahren durchfuhrende RcgcWStcucrcinhcit kann tiber Filtcrmittel vcrfiigen oder iibcr Filtermiltel mil dem 
t Lenkstcilmotor vcrbunden sein, so dass die berechnete SlellgroBe in der oben bcschriebciien Wcise genital werden 
k;inn. 

Das oben spczifizicrle Verfahren und die Vorrichtung bietcn gegeniiber dem Stand der Technik inehrerc Vorleile: 
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- Es wird keinc echle elektronische Steer-by- Wire-Lenkung benotigt. Der bei dem in der Entwicklung befindlichen 
fahrdynamischen Lenksystem eingesetzte Lenkstellinotor ist ausreichend, da er aulomatische, gcnaue und sehr 
feine Lcnkeingriffe ennoglicht 

- Die verwendelen Sensoren ermoglichen einc genaue Berechnung der gefahrenen Bahnkurvc und damit eine ge- 
nauc Regelung des Einparkvorgangs mil st andi gen Korrekt uren und Anpassungen. 5 

- Die Auswahl der jeweiligen Soll-TYajektorie und ihre Kornbination aus Klothoidbogen und Kreisbogen ennog- 
licht eine einfache Beschreibung der Irajcktorie und eine schnelle Berechnung des Vergleichsergebnisses zwischen 
Ist- und Soll-Trajektorie wahrend des Einparkvorgangs. 

- Die durch die RegeWSteuerein licit ausgefuhrle Regelung ennoglicht ein priizises Manover und letitporiire Ab- 
weichungen von der Soll-Trajektorie, urn den Fahrkomforl zu erhohen. 10 

- Die Filterung erhoht den Fahrkomforl, da sic ruckhaftc Bewegungen des Lenkrads glatten kann. 

Die nachstehende Beschreibung beschreibt cin bevorzugtes Ausfiihrungsbeispiel des erfindungsgemaBen Verfahrens 
und crlautert gleichzeitig die Durchfiihrung durch die erfindungsgemaBe Vorrichtung unter Bczug auf die beiliegende 
Zeichnung. 15 

Zeichnung 

( Fig. ! zeigt schematise h Fun ktionsblocke der erfindungsgemaBen Vorrichtung; 

Fig. 2 zeigt graphisch die geometrische Grundlage zur Ermittlung einer Bahnkurve liber den Zusammenhang zwi- 20 
schen dem Krumrnungs radius R, dem Winkel 9 und dem Weg s; 

Fig. 3 zeigt graphisch ein Klothoid als ein Kurve, deren Kriimmung c(s) sich linear mil dem Weg s verandert; 

Fig. 4 veranschaulicht in einer ebenen Darslellung eines Kraflfahrzeugs GroBen, diezurBesliiiunung der Klolhoidbt)- 
gen dienen; 

Fig. 5 erlautert graphisch einc Trajcktorie und einen Lenkwinkei fiir einen Fall, wo eine Fahrt am Lenkeinschlag not- 25 
wendig ist; 

Fig. 6 zeigt graphisch eine Trajektorie und einen Lenkwinkei fur einen Fall, wo keine Fahrt am Lenkeinschlag not- 
wendig ist; 

Fig. 7 zeigt eine mit dem dargestellten Algorithmus erzielte Einpark-Trajektorie. 

30 

Ausfiihrungsbeispiel 

Das im nachfolgenden Text dargestellte Ausfiihrungsbeispiel eines erfindungsgemaBen Verfahrens zur Unlerstiitzung 
des Einparkens eines Kraftfahrzeugs und einer zur Durchfiihrung des Verfahrens eingerichteten Vorrichtung (kurz: Ein- 
parkassistent) verwendel insbesondere folgende Sensoren: 35 

- Ullragschallsensoren zur Erfassung der Umgebungsbedingungen; 

- aktive Radgeschwindigkcitssensoren, die Radgeschwindigkeitssignale bis zum Stillstand des Fahrzeugs liefern; 

- einen Lenkwinkei sensor; 

- cincn Drehratensensor, mit dem Signalc iibcr die Gicrgcschwindigkcit crfassbar sind; und 40 

- (optionell) einen Qucrbeschleunigungssensor. 

Es istdenkbar, in einem anderen Aus fuhrungsbei spiel der vorliegenden Erfindung einen oder rnehrere der beispielhaft 
angefiihrten Sensoren wegzulassen, entweder weil das erfindung sgemaBe Verfahren auch ohne.das von dem entsprechen^. 

"Tie^^sTFg^iefe^^ 

struiert werden kann. Welche Sensoren zur Durchfiihrung des erfindungsgemaBen Verfahrens latsachfich eingesetzt wer- 
den kann von einem Fachmann anhand seines Fachwissens im Einzelfall entschieden werden. Es ware es bspw. denkbar, 
auf einen Drehratensensor zu verzichten und das Drehratensignal aus anderen Sensorsignalen zu rekonstruieren. 

Fig. 1 zeigt Funktionsblocke des Einparkassistenten. Aus dem Block 1 stehen Fahrzeugdaten zur Verfiigung. Bei- 
spielsweise isl der Block 1 ein Speicher, in dem die Fahrzeugdaten abgespeichert sind. Eine alternative Moglichkeit ist 50 
ein Regel-/Sleuerwerk, das die Fahrzeugdaten enihalt. Der Block 2 ist der Sensorblock, der die oben erwahnten Sensoren 
umfasst. Der Funktionsblock 3 bcrechnet die Soll-Trajektorie in der weiter unten beschriebenen Weise und erhalt dazu 
die Fahrzeugdaten aus dem Block 1 und die Sensorsignale aus dem Block 2. 

Ein zur Enni tilling der Ist-Trajcktoric vorgcschcncr Funktionsblock 4 erhalt cbcnfalls die Fahrzeugdaten aus dem 
Block I und die Sensorsignale aus dem Block 2 als Eingangssignale. Insbesondere ist der Drehratensensor zur Rekon- 55 
struktion des Gierwinkels wichtig. Altemativ kann der Gierwinkel auch durch einen entsprechenden Gierwinkelsensor 
gemessen werden. 

Die im Block 3 vorgegebene Soll-Trajektorie und die im Block 4 ermittelte Ist-Trajeklorie werden in einem Verglei- 
cher 8 verglichen. Aus dem Vergieichsergebnis und aus Signalen der Blocke 1 und 2 berechnet der Funktionsblock 5 die 
StellgroBe. Der Verglcich zwischen den Soil- und Ist-Trajektnrien ennoglicht eine genaue Regelung des Lenkwinkels 60 
millets der im Block 5 hereehnelen StellgroBe. Diese Regelung ist moglich, da die LenkeingrifTe von einer RegeWSteu- 
ereinheil ausgefuhrt werden. Die im Funktionsblock 5 berechnele StellgroBe wird im Funktionsblock 6 gefiltert. Diese 
Filterung bewirkt eine Glallung der Flanke der StellgroBe und eneicht damit, dass die Lenkbeschleunigung und der Ruck 
am Lcnkrad nicht zu hoch werden. AuBerdem werden dem Funktionsblock 6 auch Fahrzeugdaten aus dem Block 1 zu- 
gefuhrt und dort. gelilten oder in die Filterung der StellgroBe mit einbezogen. 65 

In dem Vergleicher 8 konncn neben der Ist- und der Soll-Trajektorie auch Fahrzustandssignale, bspw. die Oricntierung 
des Kraflfulirzeugs, mitcinander oder mit den Fahrzeugdaten verglichen werden. Der Funktionsblock 7 reprasentiert cin 
Stellglied, das als ein Lcnkstclimotor ausgebildei ist. Die Sensoren und der Lenkstellinotor konncn Tcil cincs fahrdyna- 
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mischen Lenksystems des Kraftfahrzeugs sein. Die zusatzlichcn Kosten Fdr eine erfmdungsgemafle Vorrichtung in cinem 
Kraflfahrzeug konnen so auf ein Minimum redzuiert werden. 

Die oben bezogen auf Fig. 1 beschriebenen Funktioncn des Einparkassistenten konnen von eincr RegeU/Steucrcinhcit, 
z B einem ohnehin im Fahrzeug vorhandenen Fahrzeugrechner ausgefuhrt werden. 

Nachstehcnd werden untcr Bezug auf die Fig. 2 und 3 die geotnetrischen Grundlagen zur Ermtfllung emer TVajeklone 
auf der Basis eines Klothoidbogens beschrieben. ™, ■ 

In Fig. 2 ist graphisch dcr Zusammenhang zwischen dem Kriimmungsradius R, dem Winkel 9 und dcra Weg s einer 
beliebigcn Bahnkurve veranschaulicht. Fig. 2 zeigt, wie der Winkel 0 sich mit der Anderung des Wegs s in Abhangigkeit 
vom Kriiiimiungsradius R verhall. Die Krunimung c(s) isl mil Gleichung 1.1 gegeben: 



C(S) = 



de 

ds 



Gl. 1.1 



Der Winkel 9 berechnet sich aus dem Weg s anhand der folgenden Gleichung: 
o 

Diese Gleichung laBt sich miL Hilfe der Gleichung 1.1 wie folgl ausdriicken: 
0 

Aus dem Winkel 9(s) werden die kleinen Anderungen (dx, dy) der kartesischen Koordinaten (x, y) berechnet: 

cos(e) • ds 



dx(s)" 









sin (9) - ds_ 



Gl. 1.4 



Die Koordinaten (x, y) werden aus der Gleichung 1 .4 abgeleitet: 

W \ \ 



Gl. 1.5 



45 Die allgemeine Gleichung 1 .5 wird fur den speziellen Fall der Klothoide vereinfacht. Die Klothoide ist eine Kurve, de- 
ren Krummung c(s) sich linear mit dem Weg s verandert. Diese Kurve wird auch als Comu-Spirale (siehe Fig. 3) be- 
zeichnet 



c(s) = k • s +c 0 GL 1.6 

Aus dem Einsalz der Kruinmung (siehe Gl. 1.6) in die Foriuel 1.5 crgibt sich: 



55 



r 

> 0 + Jsin S Q + \{k w + c 0 ) dw 



■dx 



Gl. 1.7 



was sich unter den Bcdingungen: 
e 0 = 0, x 0 = 0 co = 0, y 0 = 0 Gl. 1.8 
65 wie folgt vercinfachen liissi: 
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Gl. 1.9 



Die Integration der Funktionen sin(u 2 ) und cos(u 2 ) ist nicht trivial. Dafiir wircl die Reihenentwicklung der irigonoine- 
trischen Funktionen angewandL >0 



5<- i)ri V 



dt 



(2n + l) 



Gl. 1.10 



Untcr bestimmten Bcdingungcn von Konvcrgcnzcn der Rcihcn (Gl 1.10) kann die Rcihcnfolgc der Summc und der In- 
tegration invertiert werden. Diese Bedingungen sind in dem vorliegenden Ausfuhrungsbeispict (Gl. 1.10) erfiillt. 



(2n) 



[(-!)■ .Li — L~* 



Gl. 1.11 



. DieGIeicbung(l.ll)lasstsich wie folgt transformicren: 



■vWl 

y(i)J 



S ( " iy '2.(4i. + 1).(^) 
§^^"2.(4n + 3)-(2ii + l) 



Gl. 1.12 



'~10 + 120 9360 ^685440 ; 



£--£- + -£ + 

3 42 1320 75600 



6894720 



Gl. 1.13 



DieGleichung 1.13 dicnt dazu, bedeutende PunktederTrajcktorie schncll zu bcrcchnen. Ini folgenden Abschnitt wird 
das Verfahrcn angewandt, urn eine Einpark-Trajektorie zu bercchnen. 

Wcitcrhin wird bezogen auf die Kig. 4 bis 7 die Einpark-Trajektorie mil Milfc eines Algorilhmus bcrechnel, der auf der 
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vorangehend crlautertcn Gleichung 1.13 hcruht. 

Inluiiiver Lenkvorgang 

.S Es sei angenommcn, riass das zu parkende Fahr7.cug parallel zu der Parkliicke stent. Die Trajektorie in der Langsrich- 
tung wird passend zu der exisiierenden Parkluckc vorausgesetzt. tntuiiiv soli die Einpark-Trajektorie die folgcnden Pha- 
sen beinhaltcn: 

1 . Geradeaus ruck war Is fahren, 
id 2. weiterfahren (eventuell langsamer) und das Lenkratl nach rectus bis zu dein Lenkeinschlag drehen, 

3. weitcr riickwarts fahren, 

4. Lenkrad nach links bis zum Lcnkeinschlag drehen, 

5. weiter riickwarts fahren, 

6. Lenkrad wieder gerade stellcn, und 
i 5 7. das Hahrzeug anhalLcn. 

Berechnung des Lenkwinkels 

Die oben beschriebenen intuitiven Phasen sollcn formaLisiert werden. 

20 ~ Wegen der einfachen Handhabung von Klothoiden wird angenommen, dass die Phasen 2, 4 und 7 Klothoid-Tra- 

jektorien sind. 

- Wegen der Symmetric des Einparkvorgangs sind die Phasen 2 und 6, 3 und 5 symmetrisch. 

Die Bestimmung der Phase 2 wird anhand der Fig. 4 hergelcitet. Die Klothoide sind durch eincn Parameter k be- 
25 stimrnt, der auf der Begrenzung des Lenkwinkels und der Fahr- und Lcnkgeschwindigkeitcn beruht, 

Die Langc der Phase 3 ist so bcrcchnct, dass das Pahrzcug ticf genug in die Parkluckc fahrt. Der Einfluss dicscr Langc 
auf die Trajektorie wird anhand der Fig, 6 und 7 dargcstellL Insbesondere zeigt die Fig. 6 die Trajektorie des Fahrzeugs, 
wenn die Phase 4 nichl existiert. 

Die wichtigen Punkte fiir die Berechnung der Trajektorie sind in den Fig. 5 und 6 mil den Buchslabcn A, B, C, D, E, F, 
30 G, R gekennzeichnet. 

In Fig. 4 ist schematised bei einem Fahrzeug mit eingeschlagenen Vorderradern der sich ergebende Radius R = l/c(s) 
und der Lenkwinkel 5(s) dargestellt. Die Klothoide ergibt sich zu 

c(s) = k • s+c 0 Gl. 2.1 

■15 

Der Ackcrmannwinkel ist 
5(s) = arctan[L ■ c(s)] Gl. 2.2 

Gl. 2.3 



c = tan 

Daraus-crgibt sich:— - 

k ■ s max <; tan 



Gl. 2.4 



50 Dies ergibt 
1 

s max = — ■ tan 
k 



Gl. 2.5 



Der Lenkwinkel ergibt sich zu: 

h'C L-k-v 



Gl . 2 . 6 



l+[L-c] 2 1+[L-C] 2 

Daraus erhalt man den fur die Klothoide bcsliminenden Parameter: 

c max 
6 M 



k = 



Gl. 2.7 



L • v max 

Dabei findclcinc Bcgrcnzung der Lcnkwinkclgcschwindigkeit 8 < 5 M ,nax t des Lenkwinkels 8 < 5 v m4 * unci der Fahr- 
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geschwindigkcit v < v max stalt. Das Ergcbnis des Einparkvorgangs mil dein zuvor erlautertcn Algorithmic tst in Fig. 7 
dargestcllt, welchc in einem x-y-Koordinatensystem eine beispielhaflc Einpark-Trajektorie und den zugrundcliegenden 
Soll-Lenkwinkel veranschaulicht. 

Um die S'teuerung iin Fahrzcug zu programmiercn, wird der gefahrene Weg bcnotigl. Lin Fahrz.eug wird dieser Weg 
mil. aktiven Radgeschwindigkcitssensoren oder in vereinfachtcr Form mil Hilfe eines Weggehcrs gemessen. Die Radge- s 
schwindigkeitsscnsoren konnen die Radgeschwindigkeii bis zur (Jeschwindigkeit Null prazise erfassen. 

Bei demoben bcschriebenen System darf der Fahrer wahrend des Einparkvorgangs Lenkeingriffe durchftihren, Diese 
Lenkeingriffe habcn aber keinen EinfluB auf das ManSver. Falls beim Einparken ein Hindernis im Wege stehl, sol! der 
Fahrer bremsen und den Einparkvorgang sloppen. Da der Lenkradwinkel mil dem zugrundcliegenden Lcnksyslem sen- 
sorisch erfasst wird, werden die Fahrereingriffe am Lenkrad durch den Lenkstellmotor wahrend des Einparkens kompeu- to 
siert. Dicse Vorgchensweise ermoglicht, dass der Fahrer trotzdem das Gefuhl hat, den Einparkvorgang sclbst zu sleuem 
und sich deshalb wohl fuhlt. 

Aufgrund der vom Drehratensensor gelieferten Signale wird der Gierwinkel berechnei. Bei hochdynarnischen Fahr 
manovern kann dicse Berechnung u. U. zcitlich problematisch sein. Beirn Einparken tretcn dagegen in der Regel keine 
Schwierigkciten auf, da sich die Fahrgeschwindigkeit und die Dynamik des Fahrmanovers in Grenzen halt . 15 

Somit ermoglicht der Einparkassistent iiber die Berechnung des Gierwinkels eine echte Regelung des Lenkwinkels 
durchzufuhren, damil die Fahrzeugorientierung dem erwarteten Verhaltcn entspricht. Mil dieser Regelung konnen Fch- 
ler, die zu einer Ab weichung zwischen den gefahrenen und der berechneten Trajcktorie fiihren konnen, wie bspw. Fehler 
in der l^nkanlage oder unterschiedliche Reibungen, korrigiert. werden. 

Da der Sprung des dem Lenkstellmotor als StellgroBe zugefuhrten Signals zwischen den Phasen, in dencn der Lenk- 20 
winkel konstanl isl (Phasen 1, 3 und 5) und den Phasen, in denen sich der Lenkwinkel verandert, zunachsl abrupt ist, wird 
die SlellgrbBe in dem in Fig. 1 gezeigten Funktionsblock 6 gefiltert, indent die abrupten SprUnge der StellgroBe gcglattet 
werden. Dabei kann die SLellgroBe gefillerl werden, damil die Lenkbeschleunigung begrenzl isl. Da die Soll-Trajektorie 
unvcrandert bleibt, konnen Abweichungen von der Soll-Trajektorie auftreten. Es werden also tcmporare Abweichungcn 
von der Soll-Trajektorie geduldet, um ein gleichformiges Fahrmanover zu crmoglichen und um dadurch den Fahrkom- 25 
fort zu crhdhen. Die Abweichungcn zwischen der Soll-Trajcktoric und der Isl- Trajcktorie werden im Laufc des Einpark- 
vorgangs durch die Regel-/ Steuereinheit mil Hilfe des erfindungsgemaBen Verfahrens korrigiert. 

Patentanspriiche 

30 

1. Verfahren zur Unterstiilzung des Einparkens eines Kraftfahrzeugs, das mil einem Lenkstellmotor und Sensoren 
zum Erfassen der Fahrzeugposition, des Fahrzustands und veranderlicher Umgebungsbedingungen ausgeriistet ist, 
wobei auf den Refehl eines Fahrers hin eine gcregelte Unlersrutzung des Einparkvorgangs mittels des T-enkstellers 
und gestutzt auf vorbestimmte Fahrzeugdaten und auf Signale der Sensoren ausgefuhrt wird, gekennzeichnet 
durch folgende Schritte: 35 

A Erfassung einer das unterstiitzte Einparken initiierenden Befehlseingabe des Fahrers und Erzeugung eines 
Inilialisierungssignals; 

B Erfassung der momentanen Fahrzeugposition und des Fahrzustands aus den Fahrzeugdaten und wenigstens 
aus einem Gierwinkelsignal und aus einem Wegcsignal; 

C Erfassung der Umgebungsbedingungen aus von an dem Fahrzcug angebrachten Sensoren crzcuglcn Signa- 40 
len; 

D Vorgabe einer oder mehrerer Soli-Taj ektorien, die eine von der Fahrzeugposition, dem Fahrzusland, den 
Umgebungsbedingungen und den Fahrzeugdaten abhangige Soll-Bahnkurve des einzuparkenden Fahrzeugs 

an geben; -_ ■ 

E Erfassung einer jeweiUgen Ist-Trajektone, abfiangig von den jcwedigen in denSehritlen B und'C erfassten 45" 
Signalen; 

F Vergleich der in Schriti D vorgegebenen Soll-Trajektorie und der in Schritt E erfassten Ist-Trajektorie; und 
G Berechnung der jeweiligcn StellgroBe fiir den Lenkstellmotor aus dem in Schriti F erhaltenen Vergleichs- 
ergebnis. 

2. Verfahren nach Anspruch 1, dadurch gekennzeichnet, dass der Lenkstellmotor und zumindesl ein Teil der Sen- so 
soren Teil eines fahrdynamischen Lenksyslems des Kraftfahrzeugs sind. 

3. Verfahren nach Anspruch 1 oder 2, dadurch gekennzeichnet, dass das in Schritt B crfasste Wegcsignal von je ei- 
nem an jedem Fahrzcugrad befindlichen Radgeschwindigkeitssensor erfasst wird. 

4. Verfahren nach einem der Anspriichc 1 bis 3, dadurch gekennzeichnet, dass das in Schritt B crfasstc Gierwinkel- 
signal von einem geeigneten Sensor gemessen wird. 55 

5. Verfahren nach einem der Anspriichc I bis 3, dadurch gekennzeichnet, dass das in Schritt B erfasstc Gierwinkel- 
signal aus einem oder mehreren in den Schritten B und C anderweitig gemessenen Signalen, insbesondere aus ei- 
nem Drehratensignal oder aus dem Wegesignal, rekonstruiert wird. 

6. Verfahren nach einem der vorangehenden Anspriiche, dadurch gekennzeichnet, dass die Umgebungsbedingun- 
gen in Schritt C mittels eines Ultraschallsensors erfasst werden. r,( > 

7. Verfahren nach einctn der vorangehenden Anspriichc, dadurch gekennzeichnet, dass die in Schritt C erfassten 
Umgebungsbedingungen die Form und/oder AusmaBe einer Parklucke angeben. 

8. Verfahren nach einem der vorangehenden Anspriiche, dadurch gekennzeichnet, dass die oder jedc in Schriti D 
vorgegebene Soll-Trajektorie aus einem oder mehreren KJolhoidbGgcn und/oder einem oder mehreren Kreisbogcn 
zusammengcsetzl wcidcn. ^ 65 

9. Verfahren nach einem der vorangehenden Anspriichc, dadurch gekennzeichnet, dass die im Schritt E bcrcchnete 
StcllgroRe einer Filterung unterworfen wird, um zu vermeiden, dass die Lcnkbeschlcunigung und der Lenkruck zu 
hoch werden. 
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10. Veifahren nach eincm der vorangchcndcn Anspriiche, dadurch gekennzeichnet, dass LcnkcingriQ'c des Fahrcrs 
lolcriert werden, aber keincn Einfluss auf den Einparkvorgang nehmen. 

1 1 . Vcrfahren nach einem der vorangehendcn Anspriiche, dadurch gekennzeichnet, dass die Einparkgeschwmdig- 
kcii durch Gas- und Brenispcdaleingritte des Fahrers beinllusst und die Lenkwinkel aussehlieMich durch die Stell- 
newegungen dcs Lcnkstell motors hewirkt werden. 

1 2. Vorrichtung zur Durchfuhrung des Verfahrens nach einem der vorangehendcn Anspriiche, dadurch gekenn- 
zcichnet, dass die Vorrichtung eine Regel-/Steucreinheil, die von den Sensorcn in Abhangigkeit von der Fahrzcug- 
position'dem Fahrzustand und den veranderiichen Umgebungsbedingungen erzeugten Signale sowie die Fahrzeug- 
dalen emprangl, Mitlel zur Berechnung einer Isl-Trajeklorie aus den Sensursignaten und den Fahrzcugdaten, Miltel 
zum Vcrgleich der jeweils berechneten Ist-Trajektorie mil einer vorbestimmten Soll-Trajektorie und Mittel zur Be- 
rechnung einer StellgroGe fur einen Lenkstcllmotor aus dem Vergleichsergebnis aufweist. 

1 3. Vorrichtung nach Anspruch 12, dadurch gekennzeichnet, dass die RegcWSteuereinheit die von den jewciligen 
Sensorcn erzeugten Signale sowie die Fahrzcugdaten von einer anderen Steuer-/Regcleinheil in dem Fahrzeug emp- 
rangl. 

14. Vorrichtung nach Anspruch 1 3, dadurch gekennzeichnet, dass die andere Steuer-/Regeleinheit als cin fahrdyna- 
misches Lenksystem des Fahrzeugs ausgebildet ist. 

15. Vorrichtung nach einem der Anspruch 12 bis 14, dadurch gekennzeichnet, dass Filtcrnuttel in funktioneller Ver- 
bindting mit der Regel-/Steuereinheit vorgesehen sind, urn die von der RegeWStcuereinheil berechnete StellgroBe 
so zu fillern, dass die T^nkhcschleunigung und der T,enkruck nicht zu hoch werden. 

Hierzu 4 Seite(n) Zeichnungen 
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